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[0 



\\P\S)x P"(S)\\ = \\u'(S)\\ = + cos 2 ar(S) 

||/>'(S)f A A 



(2-12) 



0 7 1] 

=k 0 . 3 ^tu ?nvn* ft *6± felt* 7 ;l ^jg#§ t fts£ * £ft*§U%^8S 

db Z> Z t t>*T' % -5 o 
0 7 2 ] 

- 3 ) |SJ § **3t & 3 )^7L * n V >f K ft*fc<7>£j& 

CO «fc 7 & . £> £ 3)X7U * a V -i H ft*£ i: |gj Lt * § $ . fl^T fa § >b*i# & 3 Uit 9 n 
ft m * £ -5 3 htlcouTfx^. 
0 7 3 ] 



i&j&P s t&j&P ^W^. 3/^tu ft*fttf> ? n v -f H 7 > - ? fc*. h, a 0 > ap a 

2 . b 0 . b j , b 2 ^ 7ocof6T-v^ £ § 1'<Xtl ? a v >f H ftftg C j ;b»£> £ fc i" § . ^ § . JfJf&lEl 

i* ^i»±. Tie<^ (2-n) (2-H) ^x-m £ ft£ o 



[ 0 0 7 4 ] 
[#21] 



a } = a a +a v S + a 2 S 2 (2-13) 
/?, = ft 0 + b,S + b 2 S 2 (2-14) 
[ 0 0 7 5 ] 

c <r> 3 /Xtc ft*g m c ± § $ . ff^Tft § ft»3l#3)X7U ?o'MH tt*&C 2 lc 

*?ot a . p 1 s . p ' e ^^^ t-?z t . %n?np ' S = P e . P * e = P s 4- -5 

o if ttiniiicov^T%£s^\ to c s t*>* c t t mm^it^mc ^ c 

2 lctev^tf Lv^ 0 }X ic 3 }X7U ? a y >f k ft Jit C 2 k: It -5 tilt t li , -Mlzm c mm^ 3 'A 
7C * n vM H ft It C jlc felt § ft IS t t ifft § [c * & 3 £ § t . ft It C ^JfijilHllS 
fta\. <9 i t ftl£C 2 ^fi*J^ft a 2 . P 2 fc ^ W lc li - TIS^ ffi # * - £ fc* ^ 

[ 0 0 7 6 ] 
[12 2] 

a 2 (S) = a l (l-S) + n (2-15) 

0 2 {S) = ft(\-S) (2-16) 
[ 0 0 7 7 ] 

Ctl^<^5ttt^Ii-t§i:. Tie<7> (2-17) (2-18) jST^ISft*. 
[ 0 0 7 8 ] 
[#23] 

oc 2 (S) = (a 0 + a, + a 2 +/r) - (a, + 2a 2 )S + a 2 S 2 (2-17) 

= (ft 0 + ft, + ft 2 )-(ft, +2b 2 )S + b 2 S 2 (2-18) 
[ 0 0 7 9 ] 

0- a \ > a * 2 , b ' 0- b ' 1- b ' 2 l± - 1^ ^ ^ ~ 9 ^ ^ v ' T - ( 2-19) 

[ 0 0 8 0 ] 
[#24] 

p; - k 

a' 0 = a 0 + a, + a 2 + ;r 
«J = -(a, + 2a 2 ) 
<3 2 — a 2 

b' 0 = b 0 + ft, + ft 2 (2-19) 
ft,' = -(ft, +2ft 2 ) 
ft 2 = ft 2 



[ 0 0 8 1 ] 

3 <r> m % m ^ tut . m c ± § 3 . j^tt x* i«j § a* 31 * s#:7u ? n v h ft n * £ 

[ 0 0 8 2 ] 

(1-4) 3 iX7C ? n vM K #§U 

P i t P 2 % Jf ^> ^ 3 "Alt ? a V -i Kft!jfc<7>?nvM K ^ 7 h , a 0 , a j , 

a 2 .bo ,t) l' ,) 2^ 7oc7) ^ T ^ t ^ 3 ^ : 7U^ ny ^ N*ffi*ftCo ** :^t§07^)J: 
7 lc. *Pj. P 2 *JS^3iX7C^ n v >f H ftififtCo*. 3^ ^ <^ ft it ^S=S d T ^ ^P m T 

[ 0 0 8 3 ] 

3)X7U ? a v >f h ftH<^^« «k *) N ft^Cj^ftlS^h^iftMCo^ft^^ho^Sdfg 
Luc TO C ftHC!_h<7>^^^*-t £ t § <7>fflJjftCo*>tt*fc:&2E&* 

[ 0 0 8 4 ] 
[» 2 5 ] 

Si=SjS 0 (2-20) 

[ 0 0 8 5 ] 

o * »> . tt«ftc 0 <7>j**ft[Hi<te^& « £ o k ft^cj^m a i . (9 ! t comiz it. Tie 

[ 0 0 8 6 ] 
[126] 

a i (S } ) = a 0 (S tJ S 0 ) 

MSJ^MWo) i2 ~ 2l) 
[ 0 0 8 7 ] 

Ztl^<^5tti^Ii-t§ t . Tie<50 (2-2 2) ^T*H 2 *13 o 
[ 0 0 8 8 ] 
[S27] 

(5) = # 0 + a l S [/ S + a^S a 2 S 2 
/J I (5) = * 0 +^ rf 5 + 6 2 5 (/ 2 5 2 

[ 0 0 8 9 ] 

' p a * 2 > 1) ' 0' b ' T b ' 2 tt - ft'^C 0 ^ ^ > - ? ^ ( 2-2 3) ^T«lH± 

[ 0 0 9 0 ] 



[S28] 



a 0 


= a 0 






f 

a 2 




K 






= b ] S J 


K 


= b 2 Sy 


ti 





(2 23) 



[ 0 0 9 1 ] 

iX \Z ft SlJ^P m ^ i& & t -t £ ft m. C 2 IC o T % *. S o ft ifft C 2 IC o T . l-ST'I^fc^ 
[ 0 0 9 2 ] 

, ft m o i: ;*c § 3 . 7f2tt fc* TO c T ft § & ft Jf$ * ft B C * 0 i: i" § . 3 <?> ft m _h tc 
fcv^T^iJ^P m tt. p m =c * o C l -s d ) x°m 3 ni o ;;x*ftiic' 0 ^^ p ra T *^*J^" * - * 
tiU, *<7>#§!I3 tifcft^<7)7 ^j&P 2 **&j& t-t-Sft^C * 2 ^ ft*&C 2 3. 0 

4£ it?* IB] C T Ifil § ^flilcfcoTv^. 1 -3T'Mi ^ tz -ft Ik t ft jj$ C \ \Z m ft v£ \Z J: 9 

ftMc * 2 ti^ 4f^t§ c t ft'Ti 5^)?, ;;x\ $ <b ic ft*tc ' 2 t it t t i-3t-M^£ 

[ 0 0 9 3 ] 

:w«!C2^^'MP<7i-n\ a" 0 . a"p a" 2 > b" 0 > b'l' b" 2 tt^ ft*ftC 0 <^^ 
v > - 9 ^fflv^T x Tie<7> ( 2-24) jtT*lH± £ o 
[ 0 0 9 4 ] 
[S2 9] 

<=(l-^){a 1 +2a 2 S </ } 
a" =a 2 (l-^) 2 

o o i a . rf (2 _ 24) 
A 1 "=(l-5 rf ){6 1 + 2*,6*J 

A" = /7(l-^) 

[ 0 0 9 5 ] 

W± «* 0 . 3/7V7U ? n V -( H ft*ICo-h^tt^^^iCib*S=S d T*>S j^PmT-ft^^ft^Cj i: C 
2 tizfrB\-f & z t fc*T* § £ o 
[ 0 0 9 6 ] 

( 1 - 5 ) 3 /Xtu ?nMF ft^Jff 
(a) ftM^jl^'tt 

— -~~> cr> 9 V -f H ft m ( la] — <n => > - 7 T ft $ tl -5 ? n V -f H ft & ) \Z is u X It . 
Z <?> IS B ft IS] <7> tf -y ^ ft & V 3 - n ft* ^ tl f ti ft ifi ft ^ gc S 2 YK T- 4 ^ <b tl § <^> T- . 
Ctl* 1 @«»5>LT»'btlsa*ft^l»I. 2 0^^- LTib tlS ft^^ft^ft^^CS 



~oc^?ny Kftl^a^t^Jl^lcts * <r> o # B \z is \^ X mm . ftsfs^il 
& J: 7 IC ^ > — 7 ^ jURi" £ 3 t I: J: o T , Vf <b fc> * t o * ? <?> ft jj$ * fF * - 
t t)*"Z £ & o 3 tl * ? o V >f H ft Ji$g? U 7 . 
[ 0 0 9 7 ] 
(b) Mffltt 

* & ^ \z & t) it fz 3 YK tu ft *1 ~k ft M \z fF § c t^fl, v^u^^fflilcfflv^c £: 

-?§ . x^Ma a p^^tf c<&^ t % z&m&mnvimtft z z t -5 

. £ W ft *S ic fc*/miSM* ff o T Mil) t5S^C> f°J i£ ^ ^ ft^vi «b frKWtat * 

^Smt-fZ* is fzMmMlztt LTft^^^fb^M^lc^tfTS £ c i: «k 9 , 

[ 0 0 9 8 ] 

flJjft • R # • fa 1; ft IS * ir <7) Slfsr ft |g it x ^ n >M H ^ 7 > - ?<^u < o 0 t L , 
*> * Wi . v»<ot^M5>-?||lc iff If Be M #^ 4- x. 3 3 t lz «k o T fF -6 3 ft'T 

ilT' § § . 
[ 0 0 9 9 ] 

* x a l/cliMv^ftl*^^t 0 tl< 3 tic ioT, V ^ 

ti s T'^^T\ 3tllT'2iX7C^n V ^ K \Z o T "t T lc f# <b tl X i> S M 35 % ffl i" -5 
C i: jb*T* § § , 
[0100] 

i-£fa . Klc*nibftTv>S2iX7C*nvMK%£-tf>T. P3 ^<t>MS'J^ ft,^ 

a ^ (9 ■&mvi\zwt%. ~t % z t xmnx £ % . z<t> 7 ^finsu^ftiiicov^Tis]— <?>j^ 

it 3 Kit ?nvn* ft*ftj$*fflv*£ d i: if S^HH * ^mtX £ 

[0101] 

(d) ^1 L <7) H $ 

njkvu -n<n*n?n-&mm.~tz z t \z * o tku©#^ic^#fi^}egi-^ :a« 

[0102] 

Ufc. ?nvn* ftiJ: LTilLfciSlcII • Wi^H • ft * V<7) fl K^n 
T4?9x ^*^fflf^vi<^ Jc 7 tc . JobfcftTl+lt^^f ^^v^o -f&fa*>. ft*ft<?)^9 
> - 9 S k:jhtf& LT . (1-7) , (2-1 0)&V (2-1 2) it tc ^i" J: 7 tc. ft*ft<^^*ft^. vi^. ft 

* ^ (ft ff fl5 \Z S h tl 5 o 

[0103] 
(e )Mt/lftiJP^^ *) 

ft^<7)3£^s*^$ s *fci±iEMfk$ ntzMz sx-3b *) . mm^^mx^it zcd£:2 izti 

J=oT. ^jnMM^ £<7>MW}&'&-$:tf:Mlz5-£. z z t h*x t . t^* ^7 a & £ ic ffl fix £ 

tzn a.<r>£k\>*mwi&iifc-&u m-tz z t \z & ^x . mx^m^mmit^m ^ z t &x% 

M£ s it m 1± ^ * >i -T- x t > ^ n lc 4? t+ S ft i: LT4i btis M • ^jn M t± ijft -ft fp] tc 
WLT^ft^ns^-e, tafe*<J0li^^<50 =k 7 iz&i&z: h\z5-2_hfitz\$.%^r&~t z^mfr 
>5rv^ 0 ft * <?> ff fib* Ml^l^F^lS'll^nMS t h fx. m$h$i& 

\z m c tz mw * tf 7 - t § ^> o 

[0104] 

( 2 - 1 ) vt^)b^m^^^^©*# 



ic «k 5 I S <^ afft ftO fiP * ± # B LT> 3 7U * o V >f H ffiftS ( 3 iX tu ? o V h'i^ 

) ^mw^mmt . z <^nw^^ s ^ft ? n y f ft&iuc «k o xiii D >ff^*itt 

ffiP^lc J: o T^/&£ *i£ ft 3 iX7C ^ n y >f h- ftjjii: fli ^ *i £ S 

[0105] 

[0106] 
[130] 

Px,(\) = Px l+l (0) 
Pz,{l) = Pz, +l (0) 

a,(l) = a, +1 (0) (3-D 

/?,(!) = A + ,(0) 

tan 7,(0 = tan v„,(0) 

jc,(1) = *, +i (0) 

[0107] 

[0108] 
[»3 1] 

7\0) = /\ +I (0) 
^(i) = ^,„(0) 

Pz,(\) = Pz l+l (0) 

cos[a,(l)-a, +l (0)] = l (3-2) 
cos[/?,(1)-/?, +1 (0)] = l 
tany,(l) = tany, +1 (0) 
/r,(l) = *:, +1 (0) 

[0109] 

[K32] 

cos[«,(l)-« /+1 (0)j = l 

T'i>5C i: ^ ^ )S il £ h 
[it 3 3 ] 

tan 7,(1) = tany, +1 (0) 
[01 10] 



[S3 4] 



tany,( 1 ) = tan-y (+1 (0) 

a', (1) _ a\ +} (0) 
/?',(l)cos«,(l) /?' /+1 (0)cosa, +1 (0) 
v«V (1)^,(0) = a\ +} (0)/?', (1) 
[0111] 

[K35] 

/»*,(!) = Px ffl (0) 
= /%,(<)) 
/»2,(l) = ft>,i(0) 

cos[«,(l)-«, +1 (0)J = l (3-3) 
cos[/? ( (l)-/? J+1 (0)] = 1 

ar;(l)/?; +1 (0) = ar; +1 (0)A'(1) 
jr,(l) = jr, +l (0) 

[01 12] 

(3-3) i^lc fcv^T . 3 jUi&H<7>ilifro'l4x ^<^> 2 ^ ti Jilt ?J ft <?> 31ic'l4 . iX<7) 1 

. 2 3 /^7U ? n vM F ft *ft S« j& T (3-3)^<t> 7 o <?> & # 5^ % it -* 3 

o 

[01 133 

G 2 jI|5c ( G ttGeometry^fl^:^) tc o u T ffl 8. f § . HI 8 tt G 2 iIM ft ffl W £ # * 
[01 14] 

G 0 jIM Ui2 3 /^tc ? n 'M H ft <o 3118 T E fc* - & ~t § G 

1 ii^ t umi&ijfafr-'&'tz z t ^v^v^. g 2 m^titmm^m mm) &^ft«»- 

gC-t £ - i: % u 7 . KT^il ic x 7' 7 A > ftiffflv^ ti* C 0 ~ C 2 31 Isc i: * fE BJf ay 
? n 7 A F ft mx ffl v> ib tl * G 0 ~ G 2 ilifw i: ^ *t Iti" £ » 
[01 15] 
[ft 1 1 



c° 




G°:#g 


c 1 




G^j&^ft 


c 2 




G 2 :igftfe¥ffittfe*lh ft* 



[01 16] 

2 3 )Xtz ? n V >f F tt<6<7>5H^'tt*#;*.fc i: § ic, C°— C 1 — C 2 . G°— G 1 — G 2 
t&^a»*>Sjb*. G ^^TMl&Jjfc^lSjfclt** — SC^tll* <fcv*. 2 3 #C7C * n vM K ft 

[01 17] 

g 2 mmx\tmm^m (mm) t-K^t^. jiwfi t i±m 9 ic^£ *i& «* 7 ieft,it 



§ IC. ft ?J [Si <7> — gC <7> }X 1C % £ 4" It *l If V* t+ ft 3 t It m PA ¥ ffl ^> — 8C X* * £ o ft ^ ^ 

*^-sc$ -es^^**)*. 2 3 iX7cft*ST. mm. mmnfa. mm^m (mmufa 

) ^ft^-gC^ ts:!: **G 2 3l!^^^/ci-^fr tc ft § . 
[01 18] 

( 2 - 2 ) M#&fttfS^HK 
iX<?> 2 II^^Iflii) s i)§. 
[01 19] 

(a) mm<7>^^ > - 7 h. a . (9 ^r-^T . 1*^3/X7C^ o V >( Hfti$S45 

(3-3)5$fcSffc-*J: 7 CiX*>3iX7G? a V >f H ft *fc <7> > < ^ > - 7%£#>5. 3 J: 
7 IC L X . YK * t C M h friz ff ifro-t -5 3 "Alt ? n V >f K ft £££ ^T' § £ . 3 

<^t\n^)m\z j: tiii\ ft*g^- ^ > - ^ <7>saitt#©T*> o . c ti^imw t of c^^^ 

tc £*ui\ ti ❖ ftff^^^ft^^#^icfE^T§ 3 fc*. tt*fcfc*iiifi-t sJti^&fcHH^toKiJg 
[0120] 

(b) ^abffi£3ftfcj&g***ft*ft<?>JiM;&i: ft£ «k 7 \z. 3 ^tu ?ov^F ft^^m^-t 

^ > - ^ -z&fe-t z> tfs^HHti (a) ck *) mnx^h *) . m *> mtwigmut ft§» z^a 

[0121] 

±iB(b) ov>t. H-g^3c*i¥«HK:iej£i-s. # < H-SI^Stt. ^<?->£7 

[0122] 

5fe%a;f7 > — ? : > — ? 

Jq/^*fr : (3-3)5$. *>5v>ii**>-gB 
[0123] 

-gp^ft*ft^ ^ > - ? * a iti^t - t o *>*vm±. m^mmxfr-omm^^] 

jb*J&£3*iTv>Sig£-|ctt. SBCfflv^ 3^tu? n V >f K ft ^SJ ic <fc Oig^L 

[0124] 

±m<vmVMLWM$\-M&'£felzi$L-$i2i±Zfzdblzit. $iM±^X^fr^mx3h^>. $i 
ftffiWftifeSU l£«r^7- 7 >f > -ft*|ft -t±. -e^ftJjft^^^^x 3^7L^a 

& o 

[0125] 

*>«v>l±, iS^-t^§^^*fr^-f\lc^^-t<^Tttft < . |lH/X*frit^Jt^ L T < 
n^ij. izmizm^mz^rt t LT*»T?*5. fJxti\ ft*ft^^<50^|iH^iX<?> =k 7 ftH 
o^STEPlc^ttT . KBiXllff-t*. I? 1 STEP LX tmmJjfafr-$Ct Z «k 7 tc 
ItWLfc^s m 2 STEP L T H^J fSj ^ -gci" S «k 7 lc ffi M*ff m3STEPTft^^ 
-SC-t* «k 7 tffliM-t*. 3<?)^>i<^iStti<^*^*m 1 0 tlB-t. '£^ft 3 )X7E ^ n V -i 
K ftJj6^&V-e<^^Jj«x vS^^ft^^Saitttfiilc^ L fzo 
[0126] 

( 2 - 3 ) 3 iX7C ^ a V >f K ft Jjfi* ffl v^fc it K ^ ^ ^SfefJ 

(a) mmtt^Wiii 



jfeftl \z o u t i¥ L < M ^ £ . 
[0127] 

3 /^7U ? n 'M F ffiP^^S^^-iTLtl i: LT lis ffi IB >Tt ^ tf> j& IB £ £ 3 YKft ?oV^F 
-fe r > > h 60 7 > - ^*^ti: L . jSEfBlcatWtt&^fcjfli »K G 2 il^i: * 

IS^ifcftfct^ft'iai G 2 ii^i:t±. 2 ^<J0 3 Kit 9 n V >f K l&mfrfv 

[0128] 

(b) G 2 il^£iM^fr 

3 tKit 9 n V >f H JgRiciJUT. jSKfglcli WW 9 . ^ o G 2 il^ i: & £ «k 7 * 
[0129] 

4-. ffiilc3o<7)^Pi = { Pxp P y 2 . Pzj}, P 2 =( Px 2 > P y 2 - P z 2 ) • Ps={ P x 3 > P y 3 ► Pz 3 
»K f^^*3iX7C^ovn , i^-?ffifflt5:i:%%i.5. HI 1 2 li^Pp P 2 > P 
3 <?> 3 ^tc * o V H Sl^^t. ^Pp P 2 W*jJS^ft*ft*ftifiC 1 . ^P 2 . P 3 W^^itt 
itttiCjttS i:, ft*ftCi<7)^ v > - 7 a 0 1 . alp a2p bOp blp 

b2p hp tt^C 2 c7>^'^ > - 9 a0 2 , al 2 , a2 2 , b0 2 , bl 2 , b2 2 , h 2 <J0 1 4M t tt 3 . * * 
W&ife fl!J k: T* T < £3c^<7>^^x? -J ^Mi^-ft^^^x? ^McWJJ5LTv^s. 
[0130] 

tcfcv^T tiM-SMc ffiPiB^m^^^ii -5 i: 7 tt 3 #(7U ?ov>(F ft h % *. 

glcov^T3o, }II^^h^lcov^T2o, ft ?£jgm<7> * # <?> ^ fr± § 2 i: ^ ft ic o 
T2o^)^t7f^ , )]i0 0 £ fz IZ o T tt . jSP2T*ttfigl:oi>T3o^3lT'$> 
£ o Wi:J:9*ff^tt^tfTM0M£>£o L ^ L . :tlT*li*^tl 4itHLT, 1:^ 

v^Ttt. MiQ^^ff^^ ? h >l * 4 x . MSi^lCov^T 2oo*o^)^ff^J|^L*ttjtJ: 
*»S^)S^f L < Lf;„ * fc. Mlcfctt *t?Jft^v£Si-*itta()p bO^i. *<r>fc 

[0131] 

Ui\ fiE<7)*fflcov^T%x^t. (4-1) (4-2) (4-3) 5* «fc 9 . Tie<7> 3 o <?> ;b*/£ 9 

[0132] 
[S3 6] 

Px i + h, cos(a0, + a\ , 5 + al, S 2 ) cos(60, + ft] , S 1 + b2, S 2 )dS - Px I+} =0 ( 4 - 1 ) 
Py^h, j[cos(d ? 0, +fll,.V + a2,5 2 )sin(ftO^ +b\ l S + b\,S 2 )dS-Py i+] =0 (4-2) 
ft, +A, J^-sinCaO, + a\,S + a2,5 2 ))dS - Pz lt} =0 (4-3) 

[0133] 

#ae. Jt*H^I^lcov^T#^.-6 t (4-4) (4-5) ^2 o^itM 1 ) j/o. 
[0134] 



m 3 7 1 



cos(aO, + a\ : + ^2, - aO /+) ) = 1 



(4-4) 



cos(/>0, +H. + 62,. -M) y+I ) = 1 



(4-5) 



ft^/c^^cS^lCov^Tli. iX<7>5^ (4-6) 3b* Ho 
[0135] 
[S38] 



AT,(l)-/f /+| (0) = 0 



(4 6) 



[0136] 

M ^ tc v£ *i ?j ft ^ h tnlcov^T%£l>, 3 K tu ? n v -f K ft *t <so ^ ? b >u n tt * 
(2-10)^7?^ 3 tl5. 
[0137] 

MMfc#*.TA*. IHSfjfi^^ft (1-0,0) tcfrLT. W W&mn ft * r * M ^ T ( 
0, cos y , — s in r ) tt5. - *l%JtJj* t TO C J: 7 tc @i $ 4± § i: . $£*ftnli5$ (4-7 

) <^ J: ■) tc It £ ti § o 
[0138] 

m 3 9 ] 



n(5) = 



cos 0 sin«(S) 
0 1 0 

-sinar(S) 0 costt^) 



cos/?(5) -sin/?(S) 0 
sin^V) cos J3(S) 0 
0 0 1 

- sin y cos ^9(5) sin aCS") - cos 7 sin /3(S) 

- sin y sin sin a(5) + cos / cos 

- sin 7 cos (^(S) 



0 

cos^ 
[-sinyj 



[0139] 

(2-10) (4-7) ^fcitiS-f £ i: 

[0140] 
[K40] 



sin 7 



cos y = 



a'(S) 



yja'iS) 2 + p(S) 2 cos 2 ar(S) 

/?'(S)cosg(S) 
<Ja\Sf + /?'(S) 2 cos 2 «(<>) 



[0141] 

o * ») » (4-8) «fc ») . STXtl ?d-MF 
ti t a n y fc** ilijroT £> tl ti «k C t ti* £> fc* <5 
[0142] 



(4-7) 



siny, cosyti (4-8) st tc jhtFC t T c t frfr) 



(4-8) 



c is n & m ffi j& t* a it a m * a -t %> tc 



m 4 i ] 



tany= — (4-9) 

/?*(■<>) cos 

[0143] 

[0144] 
[K4 2] 



tan7,(l) = tan7,,,(0) (4-10) 

[0145] 
[IS 4 3 3 

cos[ar,(l)-o;, +l (0)] = l (4-11) 



* 0 . v£*lilifro-?*)-5^frli (4-12)^T?*>*. 
[0146] 
[K44] 

«',(!)/?' +l (0) = a' l+l (0)/?',(D (4-12) 

ti 5^ ( 4 - 1 3 ) <t> =fc 7 lc5r § C i: t> . * . $6 ^ • j& lc T & 3 il h <?> 7 % <r> v> < 

[0147] 
[K4 5] 

Px,(l) = ^, +l (0) 
/> ( (l) = ^ l+1 (0) 
/>z,(l) = />z I+l (0) 

cos[a,(l)-cr I+1 (0)] = l (4-13) 
cos[#(l)-/?, +l (0)] = 1 

«;(i)/?,; 1 (o)=«; +) (0)/?;(i) 

*f,(1) = «- (+1 (0) 
[0148] 

lii _L <fc 9 * * *n 8t a 1 j . a 2 ! . b 1 j ■ b 2 j . h j , a 0 2 . a 1 2 . a 2 2 , b 0 2 , b 1 2 , b2 2 - h 2 <?> 1 2 
icWLT, ^frs^li Tie^ 1 2fflft i /j£ *) aL-o z tb*hfrZ> 0 ( ^P 3 tc is It £ ii^ fa 
t a ^ (9 3 t ^ -5 o ) 
[0149] 



[K46] 



Px,(\) = Px 2 (0) 

Pz x (\) = Pz 2 {0) 
cos[«,(l)-a 2 (0)] = l 
cos[/7,(l)-/i 2 (0)] = l 
a 1 (l) / 9 2 (0) = a,(0)/? 2 (l) 

A-(l) = A- 2 (0) 

Px 2 {]) = Px 3 (0) 
Py 2 (l) = Py 3 (0) 
Pz 2 (l) = Pz 3 (0) 
cos[cr 2 (l)-cr 3 ] - 1 
cos[/? 2 (l) -/?,} = ! 



[0150] 

C ft T* * ft! 1 2IlCov^T 1 2i«iti!) 1 ^ , )io^T-»ttft§C i:^T*§§. Z fl 

% - - h > • 9 7' y > >S ic =k o T ft? § . fl? * * ah § „ 
[0151] 

[0152] 

M ;L XX n- 1 ffl ^IJ fc» -5 i: § . NI<7)*»|[i:Nl(?)iMM , )ioi:tS 0 

$ ^ tc i&mz.fz t-t&t. 3 /^tc ?nvn* h^Pd-p p n <7> ^vn*'<7>- 

5^ a 0 n , al n , a2 r bO n , bl r b2 n , h n ^/o^-f &#5*tt* }f ^c^^?> 

& ft <r> ^ fc*:*; # $ t ~n l»J lc o T 2 o If 7 o it £ -5, . 
[0153] 

n = 3l?lJ*)3lI, m tik& t «fc lc 1 2 AS T? £ 3 t fc* ;b fc> o T o § fc» N n > 3 T* It . * 
*n & li 7 ( n - 2 ) + 5 M . 3titcMLT^^Az:oitt;7 (n-2)+5IJ>5. 3 ft T* * ft 

^fUfilt^fti 3 i: **BTfi6T?*>S. »f kLTli, 5fc%i®tt$kftiR<Dmizit (4-15) (4- 
16) m & *) o Z t * flj ffl L - ~ - h y • => ~f V y m * ffl T ftp o ( * ft 

*F**ngcfciK ift^ tr-r>ffflJJ tti. ) 
[0154] 
[K4 7] 



AF = [j]a« 
Aw - [./]"' AF 



(4-15) 
(4-16) 



[0155] 

[0156] 

(C)#l 



fJSJjftli £<7> £ 7 h tiX t v*v*fc*. 3 c T li #] SUM <7> -*f x.^^-$iJlc 

[0157] 

3D Discrete Clothoid Sp l i n e s co ftZQco £ ffl m U m lz TR^^S: 4 o <fc 

3<7>^ftJ|3Qfc><b*<7> : SJKIJffifcgaSL. Sfc^Lfc. 3D Discrete Clothoi 
d Splinesti. jfcffik:*! Wtt£;&*jffi »K ft* to- ^ <?> MM lc ft L T vf «b to^c ^ 

fbf -5 J: 7 4ttlt}f oT^5, *^«H^Ttt3iX7C ? n V >f H ill W <*> #> #J BH ffi * . 
0 1 3 <?> <k 7 ft r = 4 <^> 3 D Discrete Clothoid Sp 1 i n e s <r> # V =f > Q^: ft 0 N 3 ^blfST* 

[0158] 

Discrete Clothoid S p 1 i n e s \z o v> T ffl & |£ i" § „ 0 1 4 lc 5jk £ tl § =k 7 lc 

M^Jf AL> PcOt ft£ «k 7 ft#ft ff^Q^f^So CCT'P^Tl^^ni^Sht^i:, # 
V rf > Qtt gj D Ti^ it a T rnM. ffl X OS if r (n- 1 ) + 1 ffi ^ TI^ * ft o 3 t lc ft § 
o Ht^^^VJ^h^M^^^ILS^UT, ^TI^^diT^-t 3 t lets. 

? H >Hc * ^ #> S . 
[0159] 

zcotg. Tm<r>~m&m±w$£Miz ft § * 7 ft^ (4-1 7) l . ft***^^^^^ 

#f^i»tcJt#lJ-t § Jc7ft*frtcMtffi<ft^»i:§<7) (4-18)^0 W^C^fi/JWb-tS i: § 
co) # >; rf > Q % 3D Discrete Clothoid S p l i n e s t s 7 . 
[0160] 
[S48] 



lqi-iqih|qi + iq,|. (qi^P) 

X|A 2 * ir+I | 2 , i = {0...n-l}, A 2 k t =* M -2*. + 



(4-17) 
(4-18) 



[0161] 

3D Discrete Clothoid Sp 1 i n e s T* li §TR^<^ 7 U * £4g to*-f X lc j|< * o X 5 „ f CT' 
. *<?>&&&1i8ij5fa~< 9 h >i t «k *) => > - 7 a 0 , b 0 ^?l<#>So c <7>ttf$^ ft h >u 1 1± 
# '1 Q*:£#>fc t § t-t-?k:JB£*n t ft o Tfc 9 . c <jo t 3^tu ^ n v -f H ft m ^ f # H 

^ ic «k »J . # M =f > TS^<^> f# M ^ rS] 0 $c ft a . (9 6*^ 3 tl ic =k ») § tt,^co a 0 

[0162] 

m 4 9 ] 



u = <^ 



cos/? cos a 
sin J3 cos a 
-sin a 



(4-19) 



[0163] 

;ZT\ 3D Discrete Clothoid Splinestt. TI^ to* #5Efit lc M ^ X C i: * # ^ ^> 

x 13 1 3 <^^g 4i + 1 T-li. tt*ft^^!5CS*»l/4T?*>S fcfiflSi-tS 3 i: S. ll]^ilc^g 4 ( 

Kft^<7)a^iti:^^^-t±T#i«i-^i:TIS<^i , ((4-20)to^^i:o o 



[0164] 
[150] 




(4-20) 



[0165] 

C co ^ It * fri 1 a 1 4 j t a 2 4 j <r> 2 YK tcMal Tjg^ \z # o T 9 . Cii^iv^T^^ > — 
?ap a 2 <7) nfifl ft t -t £ o IBJ+llc ^ > - 9 bp b 2 <^f]^fi ^ § 3 . 

[0166] 

<k 0 SSi-tS. 3^7C^a>H Hfti^iitt, 5* (4-21) 3 ft*. 

[0167] 
[15 13 



a' 2 +fi' 2 cos 2 or 



[0168] 

£<7>j**3£JI3-*S (4-2 2) lc& »J . h<7>#]JUH6 3 ti* o 

[0169] 
[15 2] 

, _ V(al 4 , +2a2 4 ,) 2 +(M 4l +2/>2 4; ) 2 cos 2 («0„. + al 4 , +a2 4l ) 



[0170] 

W±tf>;fr}£-?7o<7>3iX7C*nvM K ^ 7 > - 7 lc o T #JJW ffi * £ 3 t **T- § 

^ > — 5? tf>aEflJfft* — ~ — h > • 5^';>aicJ:oT$ftfe. C ti\Z =k o T t# «b tl 

[0171] 

(d) ffiW0J 

HRSk:W±k:iE^fc^vi-?^^l*1tW Lfctffl t LT (0. 0, 0.0, 0.0), (2.0, 2.0, 2.0) 
, (4.0, 0.0, 1.0), (5.0, 0.0, 2. 0)<*>4j£*3iX7C*n V >f KffiWLfcflfc^l-fS. ffl 
Hie «k 0 iifz 3 J^tl ?nvn* ft*ft<^aS^I3*ia 1 5 01 5 l±HJi6**3 

JX7C^ny^HftIfi> > ), flfcfcSU — — £1 <«*> ift *SUi ft ijt± felt* . 



i^tiTv^:h**b*^. m 1 6 i±ffilifak:ifi;&*><btf>^iftMMI* fi£ Ufa tc ft ^ ^ |x 



(4-22) 



[0172] 



o tz ft m ^ \ t ? => -? T* -g, o 

[0173] 
[H2] 

figU(M4Ml'M^-^ iftH) 

or = -0.657549 - 1.05303S + 1.84584S 2 
/? = 1.03297 + 1.29172S -2.55118S 2 
h = 3.82679 
P 0 = (0.,0.,0.) 

a = 0.135559 + 2.18537S - 2.69871S 2 
(3 = -0.226655 - 3.15603S + 3.03298S 2 
h = 3.16932 
P 0 = (2.,2.,2.) 

a = -0.377569 - 1.45922S + 0.984945S 2 
p = -0.349942 + 1.32198S - 0.873267S 2 
/i = 1.43987 
P 0 = (4.,0.,l.) 

[0174] 
[ft 3] 

Coord : (1.16 x 10' 5 ,2.00 x 10\3.82 xlO" 6 ) 
Tvector : (7.59 x 1 0" 5 ,1 .50 x 10" 5 ,2.95 x 10" 4 ) 
Nvector : (2.93 x 1 0" 4 ,9. 1 9 x 1 0" 5 ,-7.57 x 1 0 * ) 
Curvature :3.06xl0 -7 ' 

Coord :(-4.33xl0-*,-1.64xl0- 6 ,l.llxl0- 5 ) 
Tvector :(2.06xl0- 6 ,2.33xl0\l.97xl0- 4 ) 
Nvector : (3 .3 0 x 1 0 4 , 1 . 1 9 x 1 0 5 ,-3 .23 x 1 0 5 ) 
Curvature : 5.96x10 6 

[0175] 

( 2 - 4 ) w^cfct-t 5 &{$.^mw^^m LtG 2 mm% 3 )xit * n y -i k mm 

(a) mm&ft t **a$( 

flf<7> ft 3JX7C * n V H m m$ fl £ . JKiglc S & «o § 3 YKit 9 a y -i K 



Jcov*T**nSclia|). i\> a 2 - b 0 , bp b 2 . h<7)7o*5^T, ^ftlll^^Mn-DiJ) 
4 : J: ic 4' 5 . — 7o\ ^fr^IcouTtt, n-2IJ)^liiSr t icMtL JiiML E±fe 
f W/Io*o fc&j&k: felt Sffij|g<?>3M <5*>T. ^k^T'i (H){3IT*5. 2-3<7> 

^vST'ti c fttcM • *£;£uc:fe?n-£miS^ ? h ^ ^fr^4fflit^i-c ic «k o T 

[0176] 

m • ^^icfeit-smis • mm • mm* mm t . ^-o^mmt ft& * 7 tram 

c c7) jf x 5fe ft] & <?> # ib*^ £ *) 'J? ft < ft £ . - - - h > • 7 7° v > 
£ c £: ttT § ftv^ 0 Z<r>fzdb. ft A ^> fc> T **n&fcif -5 

[01773 

< -f & z t\z Lfz« Mx.lt. 4o*ftI«^ft^i^T'iti[i, mtztt^* 2 of? A 
[0178] 

C^i|^II«*^2 of x^^)T\ §Ii*lCouT*ff^li, S£«U M<7> 

7 M o* o <t> 1 4 Mit x. § o -^T\ $C 3 & ? n v >f K Jj*# ** 2 o J# £ 5 <?> * a 0 
, a i , a 2 • b o , bp b 2 . h <^ 7 o o* o <o ff 1 4 41 * *D Sc fc*if £ -5 3 t tc ft § . z <?> i: § 
j&fll fc#*ti*^C<?>»ttn + 2MT?*>* fc^b x S i: **n&«7 (n+1) ffl. ^fritii/ 

(n + 1) + 44HI t u 7 Z \z ft § o Mfzlzff ALrz£L<7>mm<7> 1 2 -o*fcfti 

2)-3flStft*). jb*T # -5 J: 7 tc ft -6 o 3^0 «k 7 icfffcft^f? A 

*mm Lfzmm*n 7 3 t ^orsik:**. 

[0179] 

§ <b lc — fefiS ftJt ^tc o v>T -5 o nM<?>j&#l**iWf 5 i: § . MJWj&"?mM*> H @ % 

= H> jKfglc^-^%ai5 ft h&lYKJt ? a v >f K*&#lcov*T**n8Uia 0 . a 1 ■ »2- b 0' 
bp b 2 . h<J0 7 o<fc§<7)Ts **ngcii^'*"?7 (n-1) M*>-2> 3 £ iz ft s . — ^frsttco 
v^Ttt. n-2Ii>l>i^r i: lc JUg . tfM. vSJjfix ft 7M o i: J&j&k: It -6 M^<?> 

fcv^TftOP $ ft 5 ^ § Jl g ttiol^i 7 c i: lc ft § . JUTx IfeBH + Tmtt 4Jil _h<^ B ^ 
8Cx ktt2W±e«JSCT?*»S t LT> fr/ilc^^lf A L tz t % tc^frst t **a$c<7>$t^ L 

[ 0 l 8 0 ] 

(i) m=2kc7>h§ 

M^3T*>^ i±Tra=2kfflc7>Jl @ *ftOffll-r« i: S . * *a R l± ^#T« 7 (n- 1 ) ffi . ^fritti^fr 
T7(n-l)-4 + 2kM-?*>*. 3 <r> t B MM ft l&ftit It 2 k-4MT- £ . 4^ k-2M<?>^^ if lc 

^liCli^#T-7 (n + k-3) flS. *fr5^tt^#T7 (n + k-3) -4 + 2 kfi i: ft & . C ZT^ h \zffi fz\z 

^#T*I (n + k-3) +2 (k-2) fi. *fritti^#T7 (n + k-3) +2 (k-2) M t ft *) * i( * ^ <7) » 
L < ft S o 
[ 0 l 8 l ] 

(ii) m=2k+l^i:§ 

M^T#>^ i±Tm=2k+lM^>Jl B *#JfflJ-t -5 i: § . *ftiSfl^#T-7 (n-l) I, 
*T'7(n-l)!2k-3lT$>5o 3 co t £ ft^fr^ tt 2k-3MT'cfc S . 4. k-lfi<^^^Sf 



**ngUi^#T*7 (n+k-2) * sUi ^ # T* 7 (n+k-2) -3 + 2kf® t ft % . 3 3 T 3 <b ic*f 
leff A L fc^^M^fl^ 7 *>2o (fjx.tfx, y) ^*£nf(i: LTfti *£uf5( 
ti^#T7 (n + k-2 ) + 2 (k-2)M. *fr^li^#T*7 (n + k-2) +2k-3M t ft 9 ^ff^it^t^lof 
< ft -5 . f :X\ m=2 k+ 1 <r> M q- lc li W A L fc;&<7> 7 *> ^ i: o ^ & ic u T It m U <n ft 7 
*> lo fitt^^^am i: LT1&7 kt5. f 7 t 5 3 i: T\ * *a & fl £ ft T 7 (n + k- 2) +2 (k-2) 
Ms ^ttsUi^ttT? (n + k-2) +2 (k-2) li: 4 ►) fc^fr^^t^f L < ft 

[0182] 

W _h ic *E ^ tz Uft <r> J: 7 ic. iIfln3ftS&fr<7>8cic£-;b-eT. }f ALfc^^)li^7 *> 
Jt^-ft ir-^ll *<^ig^T4;*fr&fc&tt^<7>&££>;b-e£ 3 t 3b»T§ . & i& ± ffi SW & 

[0183] 
[H4] 







if 






4 


0 


0 


0 


0 


5 


1 


1 


1 


1 


6 


2 


1 


2 


2 


7 


3 


2 


1 m<K>& : 2 
1 &<D& : 1 


3 


• 


2k 


2k-4 


k-2 


k-2 fi£>,£ : 2 


2k-4 


2k+l 


' 2k-3 


k-1 


HfiCjS : 2 
1 m<D& : 1 


2k-3 



iS?k : 2 gl±©SM 



[0 1 8 4] 

(b)^v£ 

M • ^^T^-fft^ilJPf £ 3^7U ? n V >f h^ffl^tffllSU .017 Tkum 1 8 lc 
Tjk 2 tl •£> J= 7 lc iii. T <^> 5it tl T* ff t? tl £ o 
[0185] 

Stepl)§iJPi-S*ft<?> 7 ^4o^lt*fflv^TJKffik:ffimWm^*3fi 9 . ^oG 2 iIMftffl 

Step2)£/£2 iifcft*ft±k:Sf ^ft^^tfA L . fc *lnt^S^ilf s 0 

Step3) SteDl*>tt*6^ 9 > - 9^WWii.t LT, B fl&^&tffcitfc-*- «k 7 ft &ftijfctf> 
^ > - ? <t> 3£ m i I * a. - h > • 7 7' v > [c J: o T ^ db £ o 
[0186] 

WTx ^Steplc o v^Ts^B^^ffl^-t s . if StepBcfcv^T ii . ft * ffelJP & 

[0187] 

iX S t e p 2 tc 4? x m fz ft n A L . * ft t * gc <r> 8c <^> 11 IS * ff 7 3 ic ft s . 3 



Ki^^'t'l^^tf ALfc, 3 «b ic. ff A 3 n S ^ tt ^ «b IK * ic A L T u < t ^> 
[0 1 8 8] 

lc S t e p 3 \z o T T * -5 fc* , S t e p 3 ff 7 — ^ - h > • 9 7° 7 > <?> fz db co ffl ffl ft % 
ff fclCifc£-t.5<&^ ^cofzdb. m fcft^**JPA3 ftfcftJjftlcouTli. 1 -4TiE 

^fe 3 )Atu ?n>MH ft!jfc*#9J^*^?£*fflv>Tft«l*#9J L . $ *i ft*U<7> &ffi 

A 3 ft T & ft Jjft ic o u T li . SteplT£j&Lfcftif*<?> 

ffi % ffl T . - ~ - h y - =j ~7' V > v£ lc J: o T f# ^> ft fz => > - 57 <b 3 }X 7C ? n y K 

o 

[0189] 

(C)ffilM 

[0190] 
[f!5] 







h/v 




Mm 


p. 


(0,0, 0) 


(Cos( 0 ), Sin( 0 ) 
,0 ) 


(-Sin( 0 ) , Cos ( 
0 ), 0 ) 


0. 2 


p 2 


(4,-4, - 
4) 








p 3 


(8,-4,- 
5) 


(1.0,0) 


(0,-1,0) 


0. 2 



*0 = ~£i"5 

6 



[0191] 

zcD&ft-?. ^mizmm^n ~> tzmm^m 1 9tc^i- 0 iii»<7>ft«ifc*3iX7G* n v >r f 

ftM. flfc*l • -^M^ • • ^M^li&ft*S<7>tt*#«ffc^?->£^LT^ 

So 0 2 0 izm 1 9 <7>ft*ft<*>*ftiik:*tJ£3 itrz&Mm<r>tt&fr%<7)&§l}2£MtMm 

CO m ? *7 -? * Ifii" o $ ft ft $ tt . ft 6 h t> £ J: 7 tc 4 x. fz * ft % $1 fz L T 
u £ 3 2: £ o 
[0192] 





mm 






[Hi* 


p, 


Jj. x. •fit 


{0.0, 0.0, 0.0} 


{0.8660, -0.5, 
0. 0} 


{0. 5, 0. 8660, 0. 0} 


0. 20 






{0. 0, 0. 0, 0. 0} 


{0. 8660, -0. 5, 
0. 0} 


{0. 5000, 0. 8660, 0. 0} 


0. 20 






{0. 0, 0. 0, 0. 0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 


p 3 




{8.0, -4.0, 
-5. 0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 20 






{8.0, -4.0, 
-5. 0} 


{1. 0, 0. 0 , 0. 0} 


{0.0, 1.0, 0.0} 


0. 20 




m 


{0. 0, 0. 0, 0. 0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 



[0193] 

(d) * m^cDm^mm 

(b) co^'&iz Jc >) . ffifflj&lzisli-Z&ii.-&Mffl Loo. G 2 jlic ft ffl IB ft* ft z_ £ J: 7 left 
of;. ;:t\ W JN^t- ft < + ^^ic 4? t fft * $0 P -* & if tc o u t % £ s . 
[0194] 

Cfc^^-gx. L^L. § fc^^-?li*Wj&lc*m * <fi * flHl 8P 5 C i: 1ST* 

§ftv^ 0 f ZT\ 3 c X'lt Z 2o tc ft If £ C £: lc J: o T * W T <?> ft ^ ffe!l L 

o 

[0195] 

i"ft;b*>. ^^iJtcM LT-^tcffiP^^tf 7<0T«ft < . 4'W^P c *i*A,T?ft*6C 1 4:C2i: 
tc $H* T ffi M * tf "7 o * tf> it ^-^P c li . i^^lc *> £ Z t tc ft £ <r> (b) <7)^vS * ffl v> *i 
li fft % faj P -t -5 - i: T § 5 Jc 7 tc ft § . 
[0196] 

3(7) j: 7 tc^p l fcvM6<7>*>*^TE^%^tt. * cont^iz txmm l 

£*SJH£/&£ tis fl*ft*«Sv>TvMtii. St&_h. #^lcfcuxii • • ft * ft| ffl of 
lift 3#C7U * a V >f H m m * tf 7 
[0197] 

( 2 - 5 ) M^^T^ti,^. M^iJiP L 3 ^tu * n V >f H ffi m 

(a) coWifi 

m • if*^T?#fft*ftaap-r*3iX7c ^ n v >f K*fflv^ism^a:. m 2 2 tc^tism 

[0198] 

Z<7>ffl?&3iX7C^ra<5O3j&{0. 0, 0.0, 0.0}, {5.0, 5.0, 10.0}, {10.0, 10.0, 5.0}^Jf 

[0199] 
[17] 





mm 






ft* 


P. 


(0. 0 . 0. 0 , 0, 0) 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0. 1 


p 2 


(5.0, 5.0, 
10. 0) 








p 3 


(10.0, 10.0, 
5. 0) 


{1.0, 0.0, 0.0} 


{0.0, 1.0, 0.0} 


0. 1 



[ 0 2 0 0 ] 



(b-2) r = 4^3DDCS^4i/^ 

- ^ - h > . v 7- v > a ic t ti . » <?> j^sg ^ §6 & ^ ic ® ^ & m m ft ^ ^ s ^ 

Z z~Z\t% <7)%IWii.'&'&&rzdb<7)mB-&'t & o JztTm3tT>3h& 3D Discrete Clot 
hoid Splinesti. M^lc ffiHSJ Mf^tl 0 . ft ^ h <r> MM \z Jt t T Yif- <b 

^ ftf -5 J; 7 ^ttl^ff oTi^, f CT\ * fiff 2£T- 3#C7U ? a V K it m <V fzdb<0%) 
SHfit^. 13 2 3 <?> £ -7 & r = 4 <t> 3 D Discrete Clothoid Sp 1 i n e s <r> # V ^ > Q^: fF 9 s Z Z 
h If IT'3;£ L * fc. UPg lc 3 ct> ^ ^ij j; n ZiifzX ') zty ^ m 2 4 IC . TI^SE 
it ^ ^ 8 « -t± £ . 
[ 0 2 0 1 ] 

ims] 







Pi 


{0.0, 0.0, 0.0} 




{0. 4677, 0. 4677, 
3. 1228} 




{0.9354, 0.9354, 
6. 2456} 




{2.3029, 2.3029, 
9. 4966} 


p 2 


{5.0, 5.0, 10.0} 




{6.7095, 6.7095, 
9. 9244} 




{8.0655, 8.0655, 
8. 4732} 




{9. 0327, 9. 0327, 
6. 7366} 


p 3 


{10.0, 10.0, 5.0} 



[ 0 2 0 2 ] 

(b-3) WWi$.<r>m%. 

3D Discrete Clothoid Sp 1 i ne s"? l± &H;&<7> 7 u * o T £ . ^ - 

b -2T«£/£L£:# =f>Q^^.-fe}S^^lS]^ ? h ti t J: 9 v > - 9 a 0 , l) 0 ^5l<<s6^o 
c <7)}i!^^rS] ? h ^ t ti # v =f y ^^dbtz t % ici-Ticgf^a t o Tfc "9 . z^ttVA 

. d ii tc J; 9 i§- ft H <?> a o > bo^KHMfc*^ £ £<. ift^ib^iSi 5 J5X7C^ n v >f H 

■fe r > > h is \^ x it . * <7) fl H- z_ z> . 
[ 0 2 0 3 ] 
[it 5 3 ] 



u = < 



cos p cos a 
sin /? coscr 
-sin a; 



[ 0 2 0 4 ] 



::T\ 3D Discrete Clothoid Splinesii. TK;&a*#E68ilcMA,-?u£ Z b ^: % x_ & t 
. m 2 3 <JO^g 4 i + iTli . ft*ft^^^CS*M/4T-*> £ i: fifflt £ 3 i: fc*T* § £ . IB] ti lc 5 4 ( 

[ 0 2 0 5 ] 
[S54] 

-I 

f0 4 , a2 4l =a0 4 „, l) .. l 

[ 0 2 0 6 ] 

3 <7">;^ li**n& fc*a 1 4 j a2 4 j<?>2)X7U3ijA^g^tc * o X is *) . Z tit: ffl\-> X => > - 
?ap a 2 <?> Ifl KHffi £: ~t 5 - IB] +i ic ^ 7 > - 9 b t , b 2 <?>%}ffli& t § * . 

[ 0 2 0 7 ] 

8£*fr8nift*|J%hT*>5 >b*. £<7>#JSHfftk:ov*Tli3iX7C? n vM K ft *& <?> ft 3* 5$ 
«k 9 S ft £ o 3iX7C * n vM K ftJj*<7>ft4sii* TIBT^Sti*. 
[ 0 2 0 8 ] 
[15 5) 



cos a 



[ 0 2 0 9 ] 

[0210] 
[K5 6] 



*"4(<+l) 

[0211] 

1M±<7)^vST7o<7>3^7U ? n F 7 i - ? lc o T tfJSH te £ £ 3 t £ 

[0212] 

HRIk: civile «fc 9 SUM* ft 9 lclSi-» 

[0213] 



m 9 1 





a 0 


0. 0 (IE 

£n) 




-0, 2684 




1. 0739 




7T /2 (K 

53J) 


bi 


0. 0 




0. 0 


h 


12. 7684 






-0. 1648 


a l 


3, 2061 




-2. 6327 


t>o 


0. 7853 


by 


0. 0 




0. 0 


h 


9. 6752 



[02 14] 

(b-4) . mmiz^^m *) . (, 2 mm^rA7t ^vn'ii 

(l)-2)T*aSL^|l]SljI^ffluTG 2 i^i: ft £ J; 7 ^*ttTT'§li<?)^7 >- 9 
flSUft % — ~ - h > • v ~/ 7 > v£ lc oTlftS, C tile J: o T t# «b fltz => > - 9 fc* "b 3 
tfv^u ?nvMK-fer>>h L . ?U IB £ 3 }X 7C ^'MF ftiTlit^ d i: fcfr 

[0215] 

ti^J:7^*frl:ov>TM*fil^*fr^*i§. 0 2 5lij&Pi. P 2 , P3<^3iX7C^nv 

-fKim^^t. p 2 w*JK^ftifft*ft*ftc 1 . ^p 2 . P3m*^^fl*ft*tt*ftc 2 -t s 

aO j i: bO j tt ftt ic fit *dt? ft 5 ^ «b . WSll> ffi*£C i<?> ^ ^ > - 7 a 1 \ , a2 p blj. b2j 

, hp tt^C 2 <J0 > - 7 a 0 2 ■ a 1 2 ■ a2 2' b0 2' b 1 2 • b2 2- h 2^ 1 2m b * * - W^^ B H^ 
T T < -5 >C ¥ & *t ~f X ? 'J 7° h « § Et±j >jt| <50 "t "7* X 7 -7° \ z ft L X is *) . § ft 4$ lC It 

(9. v£8U ffi^^ffl^^'^ScS^rafC i: L TPxj, Pyj, Pz r a,. 
(9 i . n j , /e j <?> £ 7 [c It t" » 
[0216] 

tcgtfriftffi t LT^f x. -S^T^Pilcfctt^^friiiTf tcjg/^ L ftv^ 0 
[0217] 

iX tc ^ P 2 ic o v^t -5 o ^P 2 lift^|B]±<^fSM^Tft 9 x 0 2 31^lc ft 5 tc tiflg. Ji 

7 IZ ft -g) o 

[0218] 



m 5 7 1 



Vx 1 (l) = J Px 2 (0) 

Pz t (\) = Pz 2 (0) 
cos^O)-^ (0)] = 1 
cos[/?,(l)-/? 2 (0)] = l 
n l (l)n 2 (0) = l 
^,(1) = at 2 (0) 

[0219] 

[ 0 2 2 0 ] 
[15 8] 

ftf 2 (1) = ftr 3 

ft 2 (l) = />z 3 
cos[o: 2 (l)-<x,] = 1 
cos[#(l)-/? 3 ] = l 

[ 0 2 2 1 ] 

Jil _h «k *) . * *n a 1 J . a 2 j , b 1 j , b 2 j . hi , a 0 2 . a 1 2 . a 2 2 , b 0 2 , b 1 2 . b2 2 , h 2 <^12f® 

Ifi <7) J: "7 IZ t£ Z> o 
[ 0 2 2 2 ] 

m 5 9 ] 

/%(!) = ^2 (0) 
/>,(l) = ^ 2 (0) 
7*2,(1) = />z 2 (0) 
cos[a,(l)-a 2 (0)] = l 
cos[/?,(l)-/? 2 (0)] = l 

"l • n 2 = 1 

v,(l) = v 2 (0) 
Px 2 {\) = Px, 
Py 2 (\) = Py 3 
Pz 2 (\) = Pz^ 
cos[a 2 (l)-a 3 ] = 1 

cos[A(D-A] = i 
[ 0 2 2 3 ] 

- ^_ h > • . 7^y>at »*^*>fc. no ic^sBtt tM^m-t* 



[ 0 2 2 4 ] 
[ft 1 0] 







TsJ >v J lUi 


rrr 


M P, t P 2 t 
Wk C. 




0 0 (HF 




43 1 


-0. 2684 


-5. 4455 


**2 


1. 0739 


5. 4122 


A 


7C /2 (EF 




l 


0. 0 


-3. 8590 




0, 0 


3. 1003 


H 


12, 7684 


13. 5862 


^ P 2 t P 3 t Sr^^lft 

C 2 


*o 


-0. 1648 


-0. 033258 


a x 


3. 2061 


3. 6770 




-2. 6327 


-3. 6437 


b 0 


0. 7853 


0. 8120 


by 


0. 0 


1. 6006 


b 2 


0. 0 


-2. 4126 


^/ | 9. 6752 


9. 2873 



[ 0 2 2 5 ] 

(b-5) . }&m<r>£.!& 

m 2 6 a (b-4) -?&abfz'* y J - 9 %7t\z±i& L fcftJMl i: b-2T£>£ L =r> h * TO 

Bflcft^ L <fc tf> T *> S . H*fc*>ftiffc*> s ft*&Ci* ti^flii) 1 ftiC2T-*^. 3<7>SP§T 

[ 0 2 2 6 ] 

(b-6) . t **n$C 

02 7 lc^£ hi =k 7 lcft*ftCi<7>ft*ftj|^$CS=0. 5 <7) ^ tc ^ D P i ^ ft lc W A L fc. is tz 
, ft*fcC 2 <7>o v^T t ft*fcj%^&S=0. 5^fiElc^DP 2 ^tf fctff A L fc. 
[ 0 2 2 7 ] 

3<7>i:§. ^Pj i: ^DP^S^ft^ftfliC * ^ j& DP j fc 2 * la ^ ft % ft $ C ' 2 . & 
P 2 fc^DP 2 *JK^ftii6*ft*ftC * 3. j£DP 2 t^P 3 *^^ft*ft*ft*IC * 4 tt5= W^mHHlc 
TT < ££^<7>-* -/X 7' h l±&ft*&£lc*tJ£L-C:fc 9 . <W^.ttftJj6Ck:4Jlt*M!Slx 
IliSlfta, (9 . tti|5*ftij«j|^8CS*>WSC t LTPx c , Py c - Pz c , a c , (9 c , n c . 

k c <?> =k 7 tc^-to • ^^Jcfev^T ii. MUL m^0$5^a. (9. ft* 

%46^"?l±Px s . Py s - Pz s . as'^s' n s' « s - &J&"£1± P 1 e ■ P y e > Pz e' ^e'^c 11 e- 
/c e <r> «k 7 tc ft t" o 

[ 0 2 2 8 ] 
KIT T *) al o ^fr^: Ifi-t o 

[ 0 2 2 9 ] 



m 6 o i 



& p 1 : mm. mm. mm : 4© 

cos[a c . ] (0)-ar I ] = l 
cos[/? c ,(0)-/?J = l 
»„(<>)■■, =1 
^,,(0) = *:, 

j&dp i: mm. mm. mm -.im 

Px c . 1 (X) = Px c . 2 (0) 
Py ai (l) = Py c . 2 (0) 
Pz cl (X) = Pz C2 (0) 
cos[« c . 1 (l)-a C2 (0)] = l 
cos[/? c ,(l)-/? c . 2 (0)] = l 
n cl (l)n c . 2 (0) = l 
/c c .,(l)-/c c , 2 (0) 

^tp z : mm. mm. mm :7m 

Px c . 2 (l) = Px C3 (0) 

Py c -iQ) = PycM 

Pz c . 2 (l) = Pz C3 (.0) 
cos[tt c . 2 (l)-a c . 3 (0)] = l 
cos[/? c . 2 (l)-/? c ,(0)] = l 
n c . 2 (l)-n c , 3 (0) = l 

^ 2 (1) = ^3(0) 

^dp 2 : &m. mm. mm. mm -.7m 

Px C3 (l) = Px c . A (0) 
Py c , i (\) = Py c , A (0) 
Pz c . 3 (Y) = Pz c , 4 (0) 
cos[a c , 3 (l)-« c . 4 (0)] = l 
cos[/? c . 3 (l)-/? c . 4 (0)] = l 
n c . 3 (l)-n c . 4 (0) = l 
* c . 3 (l) = * c . 4 (0) 

jkp 3 : frm. mm. mm. mm -.7 m 

Px c . A (l) = Px e 

Pz c . A (Y) = Pz e 
cos[a c , 4 (l)-arJ = l 
co S [/? c . 4 (l)-/? e ] = l 

[ 0 2 3 0 ] 



K "7 > — 9 H a o . a i , a 2 . b 0 , bp b 2 - h <r> 7 o -0* o T *) . fc* o . ft j$ 4 ^ & <?> T* 
* £n m. it 2 8 AS t ft z> . L a* L . c *i T* li * *n $c £ * ft 1 & fc s # t < * 1^ <?> x* . ft? % ^ 

% 3"?lffcic}f ALfcZo^^DP!, DP 2 ^y- LTft 

[ 0 2 3 1 ] 

(b-7) . mm$.<7>m%. 

^<?>iJXm*^_hl-f -5 fc»lc*ftJfSc<?>#jai!fft***£-*£. ^vSirtTti. HI 2 8 <r> J: 1 iz (b 
-5) X'±f^ LfzS KJt ?n-MH ft*ft*lf L < If A L ^ Wtf ^ T*^ gij ~f * Z t IZ J: *) . 
3 iX7C * n vM K ft** £ 4 # fM . * <?> * n vM K v > - ? ^ £ £ 0 
[ 0 2 3 2 ] 

ftiC'^^ny ^ a' 0 , a'j, a' 2 . b' 0 , b'p b ' 2 li . tt*SC 1 ^^* J 5> 

[ 0 2 3 3 ] 
[#61] 



a 2 - a 2 S tl 
< b' 0 = b 0 
b\ = b.Sj 
b' 2 = b 2 S d ~ 
h' = hS d 

[ 0 2 3 4 ] 

YKlzftW}£ld?i-$:titi£lk-tzmmC ' 2 CouT*i5. * "f . tt^Cjfc^S^. Jf^fc* 
TO C T* ft § ft * ffi^C " 1 t -t & £ . * ^ ft jf§ li <7> ? a V 4 K ^ > - 9 h ' ' , a ' 
V a"!, a" 2 . b" 0 . b'^, b 1 * 2 It . tt*SC jco ft*S<50 ^* 7 >- ?£ffl^T. Tie<7> 
j-K T- /i -t± 6 
[ 0 2 3 5 ] 
[t 6 2] 



p;=p(i) 

a;=-{a x +2a 2 ) 

ft 

K = b o + ^+ h z 
b?=-(b,+2b 2 ) 

b" = b 2 
h" = h 

[ 0 2 3 6 ] 

ZtfJftijtJifciJUT^giJj&DPjti. DP ! =C * ' ! (l-S d )-e^$tlS. 3 ZT-ttiC" i^^DPi 



fs] i: a*j£&fflife&££fiKi-*ua:. ffi^C 2 li£/£f 5 Z t fc*T* § § . 

[ 0 2 3 7 ] 

W_h<7>7j>£-?. 3iX7C ^ n v >f H ft*ftCi±<7)ftJfi^^fSC**S=0. 5T*>S^DPi-eft*ftCi% 
ffi^C'jtC^iilC^SiJ-t-SC fBjti^^^T. tt*SC 2 ±^>tt*ft^^SC3t? , S = 0. 5 

T* £> -5 ^DP 2 T* ffi*IC 2 * ffi*IC ' 3 1 C ' 4 t \Z f -5 C t jb*T* § * . 
[ 0 2 3 8 ] 

C<7>^aT^9J L fc4o<7> ft Jjft 7 > - 9 1 1 Citf;„ 3<?>ftJffc<7>>< 9 > - 7 

[ 0 2 3 9 ] 
[ill] 



ft & 

c . 




o.o (gEftr) 


ft m 

c 2 


<3Q 


4. 9134 


^1 


-2. 7227 


*1 


-0. 016629 


*2 


1. 3530 


*2 


1. 3530 


*0 


tl/2 (gfc&O 


*0 


0. 41633 


^. 


-1. 9295 


*1 


-0. 37938 


*2 


0. 7750 


* 2 


0. 77507 


h 


6. 7931 


h 


6, 7931 




{0.0, 0.0, 0.0} 




{1,8431, 3.0860, 
4. 9597} 


lib m 

c 3 


*0 


-0. 033258 


ft m 




7. 1774 


*1 


1. 8385 




0. 016629 


^2 


-0. 91093 




0. 91093 


*b 


0, 81202 




1. 0091 




0. 80031 


£l 


-0. 40601 




-0. 60316 




-0, 60316 


h 


4. 6436 


h 


4. 6436 




{5,0, 5.0, 10.0} 




{7.0029, 8.1298, 
7. 5337} 



[ 0 2 4 0 ] 

( b-8) .*fr^if:t?n>7 -i K ^ 7 > - 7 * ^ a6 -5 

(b-7)-Ci*£Lfc#J8!ffi*7Ck:. (b-6) T-3aT fc&frjS*iifc-rfi?* - - - h > • 5 "7 v 
[ 0 2 4 1 ] 



[HI 2] 





*0 


0.0 (gtfcl) 


mmc 2 


a 0 


5. 3846 


a, 


0. 0000 


a i 


-3.4602 


a 2 


-0. 89854 


* 2 


4. 341 




tl/2 (gE*n) 


A, 


0. 47690 




-0. 51836 




-3.2143 


b 2 


-0. 57552 




3. 4613 


h 


5. 1836 


H 


9. 9808 




{0.0, 0.0, 0.0} 




{1.8431, 4.1726, 
1. 4653} 


ffil ^ C 3 




0. 017740 


' 4 




6. 8553 


*1 


3. 4572 


#i 


-1. 1443 


a 2 


-2. 8673 




0. 57219 


b Q 


0. 72385 


b 0 


0. 76315 


b x 


2. 4551 


b x 


-1. 1942 


b 2 


-2. 4158 


b 2 


0. 43108 


h 


6. 60818 


h 


3. 3206 




{5.0, 5.0, 10.0} 




{7.0029, 9.0734, 
5. 6186} 



[ 0 2 4 2 ] 
[il3] 





mm 








Pi 




{0.0, 0.0, 0.0} 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0. 10 


-5 IS 


{0.0, 0.0, 0.0} 


{0. 0, 1. 0 0. 0} 


{1.0, 0.0, 0.0} 


0. 10 




{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0. 0, 0. 0, 0. 0} 


0 


P 3 




{ 10. 0, 10. 0, 5. 0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 10 




{10.0, 10.0, 5.0} 


{1. 0, 0. 0 , 0. 0} 


{0.0, -1.0, 0.0} 


0. 10 




{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0. 0, 0. 0, 0. 0} 


0 



[ 0 2 4 3 ] 

(b-9) • \&m^3if& 

(b-8) -Z&dbfz'* y > - 9 \z «k *) ±f^^ iifcft*ft*ig 2 9 \z^-f„ H3tib*3 Kit ? n v 

■i \*mm. mm • -&mm • ~&mm • ^^mmit^^m^^\^-^^m^\^\z. ±b s 

* Eft Sic SMt^MLT^ttlKo £ft*#«ft^ y->«*Ltv^. 

03 01:02 9 tf>*ft<7> It *fc#ftJfc<7>ftj&fc>«b<?>^iftMlflls ft* g <^M#<^ 

7^ie-t 0 iitzmmiz. ft 1 2*^*3^5*7 tc x. tz3kft-&mrz ltus c 

[ 0 2 4 4 ] 

f j * iq l tz . 

[ 0 2 4 5 ] 

3 . 3 YKit ? n V -f H fflP^^fflv^f- # - ;i, fa £ <?> [hW# *S 8& <?> ^: If 7jv£ 

3 /tvtu ?n'MF ffi*fc<7>f8tflKff^<^J£ffl*0J kLT, ^71,^-^ -f<r>-£— >i fa 

[ 0 2 4 6 ] 

( 3 - 1 ) : r-7V?9 — 9-l-7°CDi£—)iteCcoWLtf\ 

03 17^03 5 1^7 L ^ ? - ? 7 co - fa e ^ ^ "t „ 7* 7 u ? 5Mi fa D 3f ^ K 

h 1C gl ^ 2 ft -5 ? -i 7* t . 7- V V \Z — # \Z m $ ft £ 7 -f 7° CO ^ tf> ib s £ . 0 3 1 7* 7 

U ? ? A* 7- v V t SO # <d 9 O'^^t. 
[ 0 2 4 7 ] 

l£i T \Z 7 s 7 L ? 9 Jb* 7- 'V h i: — ft CO 57 ^ 7 ' <7) # - ;L fa D tc o T s& -t % o 0 3 2li, 

7 s 7 U ? 9 A* t- -y h i: — # <F) 9 -i 7° t* — ^ fa C <7) -y v h 1 ^^t„ -h v V \ <r>ftMM\z 



ti. — m^m^^MV^^M.n^W]i¥^^M t LT . nffi # - ^ 2 ^ff^ 2 ti £ . ft 

g&i: Lx<r)t*->inmm2> \t. ft^i^n^-^ t M^m^t . nnx- >immm 2 1 
14 ti^t^. in 3 3 43 (a) ax- >immm3 ti*&*.zw;m<7>+ v v 1 tonnm^^ 

L x 03 3* (B) ttttt*-^i^l2^Ii.Stl^)-i--v h l<?)f4^i^^to 
[ 0 2 4 8 ] 

[ 0 2 4 9 ] 

ta c Ah 5 co^mmiz it. pff£w 'J - K ^ tt § i: LT > 4?-^3te 

tc xt [«] -t -5 o f n 1 co ft n * - & K ^ 1 2 A V * - ^ u m M 3 i: *a c $i 5 * - ^ f£ ^ 
M6 t^mizit. tfcfr*) MM^m%W.&<omMik t LT . IS^ ^ 3b* HE 2 ii£ o + 
v V l*»taC$iii5tcttLTffltti&tc0(gi-£<mcffv^ ISt^l-ii'+n 1 <?> ft i^f * 
-^KS§2 i: *a C lib 5 co t* - >v m^M 6 t co ^ x*ft ?»f ^Slt & h fc* 9 Mffi "t £ . 
[ 0 2 5 0 ] 

0 3 2 ic^^ti^ + 'V h l^),f-ilil3ii) t 0 3 1 tc ^ £ ti -5 7 u ? ? tc *t i" -5 

5 <7) IH H ^ — ^ L T ^ <^ ft - ^ K ^ if tc £ J: 7 tc . *-^^fei:$i5<7>fecaj7^: 
^ 9 2 -t± § . 
[ 0 2 5 1 ] 

'tft^co ^ -r* ^ co flf m&$& It m 3 5 <^ M ^ 13 ^ ia C fib tc # § o tt £: § tc . ^ *a c ill 
h ;u o ^ <b temmiz c Mrtf <b«t-t - t T*fF<b iiT v> £ ft*, c <?o H g§ ti H 3 

t # ^ *s e§ * a * m m * & m tc s ^ =+ -t s . 

[ 0 2 5 2 ] 

HI 3 7 ti * - ^ + 'fr co $im - tl co If m^l^ t L T G 2 $£ffi \z % J: 7 

tc f ^. tc ti . * - ^ 6 s 0!l^^g&tc ^-5 ^tc v> T G 2 iiM i: * § '£^***> § . C <7) fci6[£l 

[ 0 2 5 3 ] 

( 3 - 2 ) iil T tc . 3)X7C?nvn*ftitfflv^TT f 7L ^ ^ - ^ 7° <?> ^ - ^ C <50 
[ 0 2 5 4 ] 

(a-1) . fe C it h I — -"L- 

*^tf tcfc v^Tffl fzto. c Ift t >i co 1 4 tciei-o 
[ 0 2 5 5 ] 
[il4] 





28. 0 


/K— /V^^O^ (mm) 


28. 0 


^S(mm) 


24. 825 


t° y *f- (mm) 


5. 6 


— ( mm ) 


3. 175 



[ 0 2 5 6 ] 



(a-2). m£&tmm& 

[ 0 2 5 7 ] 

Its 13 3 8 «k i \z z m fa c m -ft l«] \z IX £ . 13 3 8 <^ H 14 fa £ fjH lc o X # - ^ £ 

m& L ^ § ic 4?- ^ <7>+'fr;b*J8 < ifiil IeH^MESIc A5^*jSP s > @f^S 

B&fcxbfaCfBlcJ^-SJ&fcj&Pefc L . ^P s i: ^P e <?> * j& £ j& P m i: L tz <> ^P s t ^P e ttl3 3 

— V2!Hftff^zP s 0P e <^iI. — V5HJ^^ft^y$i^fttlX£o $ <b ic tt^'tt a* <b % £ 
Ts yliii li^P ra ^ii S t L fc. <?> 7j l«J IC o X it 13 3 8 . 3 9 <r> t is *) X £> £ . C <t> 

[ 0 2 5 8 ] 

URSlcKff Lfci:£k: 1*0=15' kLT#^Ijg*^Lfc, * ft \Z J: 9 i*£ $ ft 

mul m«u s£*su \&m*mi bizm-t. 

[ 0 2 5 9 ] 
[il5] 







mm 


mm 


mm 


j& p s 


{-3. 6088, 
-13. 5249, 
2. 5563} 


{0. 96397, -0. 25829, 0. 063533} 


{0. 25881, 0. 96592, 
0. 0} 


0. 071428 


& p e 


{3. 6088, 
-13. 5249, 
-2. 5563} 


{0.96397, 0.25829,0.06353 
3} 


{-0. 25881, 0. 96592, 
0. 0} 


0. 071428 


P. 


{0. 0, 

-13. 5249 , 0. 0} 









[ 0 2 6 0 ] 

(a-3) . 

"t* ~J U ? 9 - 9 A -? <n # — ^ C <?> 00^1^<7>Stf \z felt £ fqJIg^fHc o £ = 

*i\ *P S fc/&P s lC*mT 14 fa C l^iat^ >l <7>tt"fr*>fllB***}ffi <fl«t G 2 3ll5cT 

[ 0 2 6 1 ] 

*U4tf- ^<?>+'(>t±yllll±<^*>S^*3iS<7>Tx c <7)^^^P h i: i" § (S 3 8.3 9 fl) 

(^P^yll^^Wfi) > (Jalittfl^+tf-^fS) /2 
% it § o f CT' + t^lcteViTU 

c^p h ^ mm<r>mtti$.) = (^c$t^s+*-^^xi. 2) /2 

Tftit Lfc. *fcyiWtT'*>§3 4: % # £ £ i: lc 4? It £ ?£*ft?J l«I li { 0 , 1 . 0} T? S 
[ 0 2 6 2 ] 

. Z ft iz fju z_ X fa C $| tc o T % x. 4 < T It * v^** . lc o T 14 S 1+ L 

fc0MtHSU ^i* LTv^it^l4ffi^^f]^«^^^fe *) . ipat^tiat L 
tUT, m$&* WtU L * i" 3 i: ic «k *) . mtz~t Z t t Lfzo 
[ 0 2 6 3 ] 

(a-4). =FW% £ ft & fztb lz 

fa cm tco=F ; $it. ®mm$&izA^rzm*)x&z*)^-t<. s&zffimiz & *) 

■o tzCOXl$=FWfr&Z *) -*?~t < * o T 00,^^14. fa C tt^-bSt-t C i: i: fa C Oj ^ 

M^TTUcJO-aglcMi- c 1 1)*^$<2 ftTv^s T^^iEli- s tc 14 ^> -5 gl^fa c $4^ «b HI 

Lxfrh. he \h^^.x.x7tcoikm.izm~t^^m^ c^Hi^s&t^^t^^ft t 

LTt4. ifflWf ^tUt L. ^Fijs^jettS^^fclHl^JSKkiAofcl^B^ttJjft^^ift 



[ 0 2 6 4 ] 

t+£M. (9. ft*tfliI$KS^)|K t LTPxj, (S) Pyp (S) P 

z ! (S) . a i (S) , (9 ! (S) , nj(S). « i (S) ^ «k "7 1C * . ^P s • ;&P h lc fcv^T li . mm. 
mU\Bi^n a . (9. Si, ffi*^:;£CP s T*}iPx s , Py s , Pz s , « S -(9 S . n s . k s * ^P h TiiP 
x h , Py h , Pzk, ah'^h' n h' h d^ * fa £ &Wl~t £ # - ^ ^ 4* 'h<?) fl£* 

[ 0 2 6 5 ] 

m 6 3 3 

^ p E : asisu mm : 4 « 

cos[or,(0)-a ( ] = 1 
cos[^(0)-/?J = l 
n,(0).n v =1 

«-,(0) = /r, 

[ 0 2 6 6 ] 

^itttT!Q^^T*it§o ;;x\ fa c <t> t: -v * * p i t . fa c tt 54- ft! ~% R * fa c <r> f -v * 
% ~% a o i: Lt. 
[ 0 2 6 7 3 
[& 6 4 3 



a 0 (S) = -a 0 

h 0 =y[pi? +(27rR) 2 
P 0 (S) = P. + h 0 lu(S)dS 

[ 0 2 6 8 3 

<7)5tTtt^P s tt. P S =P 0 (1 1/12) t 



it § . 



-7 



ii^g i: £ «fc 7 * tt*£C ! L T T IS <7) J; 7 & ^ ^ > - 7 * Jf o 

[ 0 2 6 9 3 
[S6 5] 



-a, 



1 fx., 11 L o ^ 

12 J 60 i, 6 



15 1 0 6 0 



[ 0 2 7 0 1 



[ 0 2 7 1 ] 
[i 1 6] 





3* 


6. 2196 






0. 0 






0.0 




u 


6. 0213 






0. 10472 






-0, 41887 




h 


1. 4631 






{-3. 6088, -13. 5249, 
2. 5563} 



[ 0 2 7 2 ] 

Zcotg. S K. is ft Z tt^Cfl t ttltC^jm. ?£ttL ft^fl^itfx L T * § ft 1 
7<7)i7lc^oTte^ G 2 il^ t*oTv^:t Jb*4U £ . 
[ 0 2 7 3 ] 
[ft 1 7 ] 





mm 










{-3.6088, -13.5249, 
2. 5563} 


{0. 96397, -0. 25829, 0 
. 063533} 


{0. 25881, 0. 96592, 
0. 0} 


0. 07142 
8 




{-3.6088, -13.5249, 
2. 5563} 


{0. 96397, -0. 25829, 
0. 063533} 


{0. 25881, 0. 96592, 
0. 0} 


0. 07142 
8 


Hi 


{0.000, 0.000, 0.000} 


{0.000, 0.000, 
0.000} 


{0.000, 0.000, 
0. 000} 


0 



[ 0 2 7 4 ] 

u tz s z<r>mm\$m 4 i > 4 2 % ax m & m *> * ie *a c u h m~t & 7 * mvt ic * o t 
z <?> ^ ^ > - 57 <^ ft jfi ^ m ^tz . 

[ 0 2 7 5 ] 

(a-5). 3 '/Kit ? n v A H ffiPtB^frit i: **n®( 
fl ^ - a. - h > • 7 7' v > tc «k o t 5j< *> § . ;c-?tT'ic*P s ^b^i^ftiCi^±it 

iftBHlCT'T < <5 3C ^ <?> -4- "7* 7 N ? ')7'Mi§fti^^7'7^ M "7° h IZ ft ffc L X & *) . §ftH 

tefctt^M^. MSfSfta. (9. ft^ft^^&S^Wft t LTPxj, (S) P y j . ( 

S)Pzj(S), a j (S) , p j (S) , n j (S) . k j (S) <?> =fc 7 ic ft f . * tz . ^P h \z is \^ X It . mm 
, liSK^a, 0 x vi &t x ft * * P x h , P y h ■ P z h , a j, , (9 h , n h , h^iitifo 
[ 0 2 7 6 ] ' 
Mg&^^l+fcv^T. JKSlciiS ^t^li^Pj t fiL? h co2&X£>Z cox. zcom^l&col 
iX7c?nvn*i^T'J>^. MiWj£-?<7>fiiW&# * * t . * ft fc* * fri 

"[0277] 

w r tc §^ tc 4? it & m n * * . 

[ 0 2 7 8 ] 



m 6 6 1 



^ p, : mm. mm. mm ■. 4 m 

cos[a 2 (0)-a,{l)] = l 
cos[^ 2 (0)-A(l)J = l 
n 2 CO)n,(l) = l 

^ p 2 : urn. mm. mm. mm :7m 

Px,(\) = Px 2 (0) 
Py } (l) = Py 2 (0) 
Pz,(Y) = Pz 2 (0) 
cos[a,(l)-ec 2 (0)] = l 
cos[&(l) -fi 2 (0)] = l 
n,(l)-n 2 (0) = l 
/r 3 (l) = v 2 <0) 

& p h : $ . mm ■. 5 m 

Px,(l) = Px h 

Py,{\) = Py h 
Pz,(\) = Pz h 
cos[#(l)] = l 
n 3 (l)-{0,],0} = l 

[ 0 2 7 9 ] 

W. _h J: *) . ^ # T fiK ") 3/. o ^ § ^ fp 5$ U 1 6 fill T § „ :ZT\ i: o V 

K ^ > - 9 \$<r> a 0 . aj. a 2 . b q ■ bp l>2' ^7tT^^ fc*o, ft,^**2* #<7>T** 

S:^ J ffi*4'U„ * 3 T ff lc }f A L 2 o </> ^ P 2 ^ y . z ^ * *a it i: L T f& o . * 
[ 0 2 8 0 ] 

(a-6) . ^ff^^ifct 9 u V >f H >*°7 > - ? £j|<#> § 

> - ? T* J> *) , H 1 9 l±# < Jf^&lcimSffifiS. JfJjftx >£*SU ffi^^-f tl%^ L tz t <?> 
[ 0 2 8 1 ] 



[ft 1 8 ] 



±f& £ *tfc *£t <ds< y * - 9 





u 


-0. 063576 




1 


0, 0000 






0. 62696 






-0. 57595 




1 


-0. 98004 






0. 77916 




h 


1. 9561 






{-2. 2429, -14. 021, 
2. 6492} 




u 


6. 8465 




1 


1. 729 






-0. 86450 




h 0 


-0. 77684 




b\ 


0. 79736 






-0. 020523 




h 


2, 69723 




£ft P2 


{-0.93007, 15.389, 
2. 3720} 



[ 0 2 8 2 ] 



#g«^fc*3tt zmm. mm, mm, ft^^tn 











ft^ 




ft 


{-2. 2429, 


{0. 83697 


{-0. 54463, 


0. 50 


Pl 




-14.021, 
2. 6492} 


- 0. 54353, 
0. 063533} 


-0.83867, 0.} 






ft C 2 


{-2. 2429, 
-14. 021, 
2. 6492} 


{0. 83697 -0. 5435 
3, 0.063533} 


{-0. 54463, 
-0.83867, 0.} 


0. 50 






{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0. 0, 0. 0, 0. 0} 


0 




fti& c 2 


{-0.93007, -1 


{0.60291, -0.592 


{-0. 10017, 


0. 688 


p 2 




5.389, 2.3720} 


68, -0.53405} 


0. 60786, 
-0. 78769} 


03 




ft C 3 


{-0. 93007, 


{0. 60291, -0. 592 


{-0. 10017, 


0. 688 






15. 389, 


68, -0. 53405} 


0. 60786, 


03 






2. 3720} 




-0. 78769} 








{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 




ft ^ C 3 


{0. 000 -15. 90 


{0.14241, 0.000 


{0.0,000, 1.0, 


0. 039 


Ph 




5, 0.0} 


0, -0.98980} 


0. 000} 


934 




XL fc 


{0.0, -15.905, 




{0.0, 1.0, 0.0} 








0. 0} 












{0.0, 0.0, 0.0} 




{0.0, 0.0, 0.0} 





[ 0 2 8 3 ] 

(a-7). Um<7)4ii& 

a-5 - a-6 tc J: 9 # h fi fz => * - 9 ic J: *K j&P s h h £ X' <D UWt It Stf ~t & Z t to* 
[ 0 2 8 4 ] 

liJ_h<o^}£T«£/£2 iifcSKt 13 4 4 lc^il-„ ^*SUi*a c fib _h(^ ^ + <frtfi.il"?*> 

sffi*ic 0 . ^p s ~^p n * T<oflfc*su — — 3 ft ti^tift^c^ c 



[ 0 2 8 5 ] 

0 4 5 lcj&P e fc><b z $iii^IE^ft^<b JlTJxBf 1+0 •) lcHim^S&^#^I Lfc^f&EBHIs 
Eft^s « <^M#<^> ^ 7^iei- 0 7*^ 7<7)*ftiBiiEi 4 4 <?>ffiifi^>Jj*ttk:WJtxLTv^s. 
[ 0 2 8 6 ] 

"7 U 7 57 _ 57 >f -foy-fc — A, ja c |c PS«b tl-f . l5USigK%>< v'T-flifiK-t -5 Pff IS 'J 7 - > 
O'? 4 7° co # - ^ *a C IC ai ffl L fz 9 . *> -5 VMi «y h JQffl \Z Wt It <b ft Tz x > H ^ t ^ 
T* ^ D t&co jj?- iiil^ «b JUv^ _hw\ >y b7)4 5 ^i§LTjxx4f | J<7>x> K ^ 
■y -7' *a C ib co t' - >i K it lc ^ -t Pff If x > K^rt -y 7' ? 4 7° <?> # - Ja c lc M M L 

[ 0 2 8 7 ] 

t C -=!> -2*5&W to Wi. tf ?J v£ % Hit -5 7° & - 9 TUff & P£ li s =i 

>tfa - 9 <r>>\ — K -f 7 X 7 ^H^^fctlftieflt ^glc 7°a r 9 LTfeg, > 4 > 

'j-lcn-H LTlftt^o -e<7)=k7&7'o?*^A«. C D - R 0 M HJj|5 

lie&«#lc ^o77A^MLT^MLfc t ), * >y h "7 - 7 ^ L T gifgg 3 ti n > t: 

[^^_h<^fijffl5ri^] 

[ 0 2 8 8 ] 

*f&BH<7) 3 7 n 7 4 F ESl^lC J: ti It . I M W m ^ & ft" ± M \Z & g i: £ § ^ W ft *£ <?> 

-t^Jt^tc. Jq/^7^^fb^7t^^^^s+^^^i:-t§„ 3 Officii. HM^*-t§fJ«W 

*>0J#*SK*>Ktf;fraicov>Ti&flj Lfcfc*. c </) ffe tc 1 43 t£ < . tf_hTfc^lc ffi 9 < 
teo U — ^ _h^^X K i? x. v h — ^ 9 -co U — n coMsi^J'ii . ') — ~r if -\ 

[Elffi^W^'SrmBH] 
[ 0 2 8 9 ] 

[01] x ylgl^)2iX7C^D Kttlt^ti. 

[02] Aid — Kit 7 a V >f H tti^r^t^tH. 

[0 3] 3 }X7C 7 n V >f H mm<7> \£ v *n a x 3 -ft (9 <7)^^^^-t 0 O 

[04] Aiei >fc 3 )X7c 7 a v >r h tti^r^t^tB. 

[0 5] m^vi^^ 7 h ;u <7)^fbM^^-t0„ 

[06] [b]CtvS2. mVtX-fag ^mt£2^coVA7t ?n'HF||§^f0 o 

[07] 3/tvtc 7 a v k mmnftm-z^-t 0 = 

[08] G 2 3l^&M<7>*ft^l)-0o 

[09] mw¥®7>fi^^^-t 0 O 

[010] 7 a vM F fflf^7)^>S^^tl<7>«W^^-t0o 

[011] G 2 ii^h «k 7 'Sr^fr^Sf fc-T 7 a v >f H ffi m <r> ^ vi 7> ifttl <7) *^ * 

[0 1 2 ] ^Pj, P 2 . P3<7)3/yX7U7a v -f KS^^^tH, 

[0 1 3] r = 47>3D Discrete Clothoid Sp 1 i n e s * ^ "t 0 . 

[0 14] 3D Discrete Clothoid Splines^^B^i-^,0 o 

[0 1 5 ] rMtc J; *) iirzV/KTt ? n v -i K ftl^IM, 

[016] mm\zifc}&frh<r>&w\w&m. mmiz^m^m^rz^m^itr^ v 0 
[018] M^^T-^m^ftijpi-ssiXTc 7 a v >f h nm^mntm 



[0 19] H P£ ic ffi M £ ft o fcJft*fc^-*0. 

[020] &ftjf«*>*&j&^<b*>^tm«i t m^im^ ^ ^ . 

[023] r = 4^3D Discrete Clothoid Sp 1 i n e s % ^ 0 . 

[0 2 4 ] 3 tl # 'J =f > % ^ -t 0 . 

[0 2 5] ^Pp P 2 - P 3 ^3/X7U ? n V >f K ffiW^-t Mo 

[026] ±f&$ iirzmmt x >> t%:^-tmo 

[0 2 7] &*WAL fz®. 

[0 2 8 ] »§J $ fife 3 Kit ? n y >f H 

[0 2 9] ttfctt*fcfc^-*ig. 

[0 3 0] &ftJj*<7>%j&fc><b<?>^fm*lsi: ft* K<7>M^*^-t 77 7 0 

[03 1 ] 7* -7 V ? 9 fc* -y h t SO # <J0 t* -7 V ? 9 — 9 A ~f <r> if- >i fee ^^i"0 o 

[0 3 2 ] 7 U ? y & + v y t — # <r> jj? — a, *a C <?> v h t^t0o 

[0333 (a) \$#- >immmfr&z-z>tkm<7>+ v h&nnm&^L. cb) itn 
[03 4 ] +v v % ia c m iz m * ^ t> h± fc^flg^ ^-t 0 . 

[0 3 5] ^*<^^-^feC<7>^im«m^^i-JS^0o 

[0 3 6] t£*<7) /K- ^ te C CO% mW$t<7>^^-%^'f 7 *7 ~7 . 

[0 3 7] 4? - >i 4> >fr <jo fill 

[0 3 8 3 IS^t^tH. 

[0 3 9 3 zfi_h^"b Afclg^t^ta. 

[0 4 0 3 *a C -if * Mi" -5 * - >i <n *>b<7> ft. ft frffi < ft m * ^ 0 . 

[04 13 yf*_h^"ba^:ft*IC 0 t C^^-tSo 

[0 4 2 3 zli±.^^a/c^P s ffiff<?>ft^C o i:C 1 ^^-t0o 

[04 3] ^P^}fALf;0„ 

[0 4 4 3 £jfc3ftfc0J#JjS8&fcft*&C o fc^-*ei. 

[0453 &? (: fr<b&M$mtmm<7>M&it^-f® 0 



[mm%] mm 
im 1 ] 




[0 2 ] 



0<S = j-<l 

4)(S) = <t> 0 +<!>vS+(J>uS 2 

h : Aft* 

s : 

<fio, <f> v, <f> u . (const) 




[0 4 ] 



[0 5 ] 




[ms] 



MIS ft ft 



f# S : j y \U 



Ih rj I "J 




P^(1)=P^ +1 (0) 

^(l)=^ + i(0) 
P^(1)=P^ +1 (0) 

cos^(l)-a I+ i(0)]= 

cosp,.(l)-ft + i(0)]=l 
a'(l)P' +1 (0)=a' w (0)|3'(l) 

1^(1) =^(0) 




( 1 ast*tco€r 70) 



G2g|§I*iSfc-tft# 



[0 9 ] 



s 2 




s i 



[010] 



STEPl 



3 ^ n y 



STEP2 









STEP 3 








3 ^oc^ n v 








j££rc& 3 































[011] 



%98lflga> 






► 


5. 


► 













[012] 



Pi 



{ hi , aOi , a1 1 , a2i , bOi , b1 1 , b2-| } 

\ 



P 2 



/ 



C2 \ 



{ h 2 , a0 2 , a1 2 ,a2 2 , b0 2 , b1 2 , b2 2 }"^ 



\ 



\ 



\ 



P 3 



[013] 



34i+2 



P4i+3 



94(2+1) 



Cl4i+1 




Polygon Q 



[014] 



p={p 0 ,....,p„_j} 

Q = {q 0 ,....,q„_ l }, 
• Polygon 




FrenetFram e{q, , t,. , b, , n,. } 

t _ q, +] -q,-i 



||q, + i 



b ( = 



(q,-i-q,)x(q/ + i-q,) 



||(q,-i-q,) x (q, + i-q, 

n, = b, x t,. 



|q, + iq,|N,-iq.||q, +1 q/-i| 

2 

k, = ^b, = — (q M -q,)x (?,_, - q,) 
Yi 



q: 



[015] 




[017] 









► 








[018] 




© &Tfc(C*f AL£,£(Step2)--- StepKDfiH^ 
© #T/z(C*¥AU£,£(Step3) 



[019] 




[02 1] 




[022] 



3. 4<D~^~h'^-7-7yi/j£;l<C&.0%mi&<V$i 

fee 




5. ofc^*7HI-± *) tt^^r^fe^c 



9. ^*ofc^'7^-?f-J: "3 [8ii&3:4-:j£ 



2. r=4 © 3DDCS CO fig 



4 . PI8S cog 






m t ft £ J; 5 * 




7^yyffit J: 


"9, ^ny-f K^7^- 





6 . *ftSt**p»©tAS^ U5 fcs 




8 . jP5^»g§i». mm. 










mm. 




11 — h >" • 




y v&tcfc >9 . ^ ta y-r 


y - 











[02 3] 




[025] 




[02 7] 




[02 9] 




[03 1] 




[032] 



[03 4] 




[035] 




[037] 



z 



\ 




[038] 



[041] 



z 
k 




[043] 




[044] 



z 



[0 4 5 



] 



K 



A 



/ \ 
/ \ 



J 



n 9 



\ / 



\ J 



80 



82.5 



85 



87.5 



90 



92.5 



mm 



ajJSBAJgJB 



390029805 

20021112 



M^UffaJW EffiSJxffl 3 T@ 1 If 6? 
THKi^tt 



